/*
 * SCServo.h
 * 日期: 2022.1.6
 * 作者: 
 */

#ifndef _SCSERVO_H
#define _SCSERVO_H

#ifdef __cplusplus
extern "C" {
#endif

#include "INST.h"
#include "SCS.h"
#include "SMS_STS.h"
#include "uart_dev.h"

#define ANGLE_TO_POS(angle)  ((angle) * 4096 / 360)
#define POS_TO_ANGLE(pos)    ((pos) * 360 / 4096)

#ifdef __cplusplus
}
#endif

#endif
